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(54) TRAVEL CONTROLLER FOR UNMANNED VEHICLE 
(57)Abstract: 

PROBLEM TO BE SOLVED: To maintain the precision of detection of an 
azimuth angle by a yaw angle sensor used for the travel controller for an 
unmanned vehicle at low cost by subtracting a specific yaw angle correction 
value from the output angle value of the yaw angle sensor which is outputted 
when a vehicle passes through a curve. 

SOLUTION: The vehicle 20 which travels on a travel path which is nearly £3° 
respectively in pitch and roll tilt angle at a curve finds and stores plane view track 
data on the travel path and the pitch and roll tilt angle at the corner curve in a 
storage device 12 previously. Then this controller is equipped with a correcting 
means 14 which subtracts the yaw angle correction value 
AiiJ=0.5.[(&phiv;2+92).u)zdt from the output angle value of the yaw angle sensor 
10 which is outputted when the vehicle 20 passes through the curve. A driving 



part controller 16 controls a driving part on receiving the output of the correcting 
means 14. In the mathematical expression, &phiv; is the roll tilt angle of the 
travel curve, 0 the pitch tilt angle of the travel curve, wz the turning angular 
velocity of the vehicle, (t) the travel elapsed time of the curve, and [an integral 
symbol. 
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* NOTICES * 

JPO and NCIPI are not responsible for any 
damages caused by the use of this translation. 

1. This document has been translated by computer. So the translation may not 
reflect the original precisely. 

2. **** shows the word which can not be translated. 
3. In the drawings, any words are not translated. 

CLAIMS 
[Claim(s)] 

[Claim 1] The car which runs the transit way whose pitch tilt angles to a 
horizontal plane and roll inclination angles in a curve are three or less 
abbreviation, respectively, The storage which made plane view locus data, and 
said pitch tilt angle and roll inclination angle in each curve of said transit way 
memorize beforehand, The yaw angle sensor carried in said car, A car a curve 
Yaw angle correction value deltapsideltapsi=0.5, [(phi2+theta2), and 
omegazdtphi of the following [ value / of said yaw angle sensor outputted in case 
it passes / output include-angle ] : Roll inclination angle [ of a transit curve ] 
theta : Pitch tilt-angle [ of a transit curve ] omega z : [ The revolution angular 
velocity t of a car ] : Transit elapsed time [in a curve : Integral notation 



► 

The transit control unit of the uninhabited car characterized by providing the 
amendment means to subtract and the mechanical-component control unit 
which controls the mechanical component of said car in response to the output 
of this amendment means. 



DETAILED DESCRIPTION 

[Detailed Description of the Invention] 
[0001] 

[Field of the Invention] This invention relates to the transit control unit of the 
uninhabited car with which the path it should run [ AGV ] has become settled. 
[0002] 

[Description of the Prior Art] When the pitch tilt angle to a horizontal plane and a 
roll inclination angle are in the path which has become settled beforehand and it 
should run, an exact azimuth is not acquired with 1 shaft gyroscope as a yaw 
angle sensor. Then, two inclinometers were attached conventionally, using 
AHRS (attitude and heading reference system) of a full strap down, and it was 
amending to the azimuth acquired from the output of 1 shaft gyroscope. 
[0003] 



[Problem(s) to be Solved by the Invention] However, by the above-mentioned 
amendment approach, the cost of AHRS or an inclinometer was high and there 
was voice which desires low cost-ization. 

[0004] Therefore, this invention aims at holding the detection precision of the 
azimuth by the yaw angle sensor currently used for the transit control unit of an 
uninhabited car by low cost, also when the path it should run has become settled 
beforehand and this transit way has an inclination to a horizontal plane. 
[0005] 

[Means for Solving the Problem] The car 20 which runs the transit way whose 
pitch tilt angles to a horizontal plane and roll inclination angles in a curve are 
three or less abbreviation, respectively as this invention shows a principle Fig. to 
drawing 1 in view of the above-mentioned purpose, The storage 18 which made 
plane view locus data, and said pitch tilt angle and roll inclination angle in each 
curve of said transit way memorize beforehand, The yaw angle sensor 10 
carried in said car, A car a curve Yaw angle correction value 
deltapsideltapsi=0.5, [(phi2+theta2), and omegazdtphi of the following [ value / of 
said yaw angle sensor outputted in case it passes / output include-angle ] : Roll 
inclination angle [ of a transit curve ] theta : Pitch tilt-angle [ of a transit curve ] 
omega z : [ The revolution angular velocity t of a car ] : Transit elapsed time [in a 
curve : Integral notation 



The transit control unit of the uninhabited car characterized by providing the 
amendment means 14 to subtract and the mechanical-component control unit 16 
which controls the mechanical component of said car in response to the output 
of this amendment means is offered. A microcomputer 18 can constitute this 
storage 12, the amendment means 14, and the mechanical-component control 
unit 16. 

[0006] Even if the yaw angle sensor which carried the azimuth of the car in 
comparison with the plane view locus data of a transit way in this car detects, 
when the inclination to a horizontal plane exists in the curve of a transit way, the 
output value of a yaw angle sensor does not show an exact azimuth under the 
effect of the pitch tilt angle of the curve, and a roll inclination angle. The pitch tilt 
angles and roll inclination angles in this curve are three or less abbreviation, 
respectively. It can amend to an exact azimuth by carrying out subtraction 
amendment of the yaw angle correction value shown in the output include-angle 
value of a yaw angle sensor by the above-mentioned formula with an 
amendment means. 
[0007] 

[Embodiment of the Invention] This invention is further explained to a detail 
based on the example of a gestalt of operation shown in an accompanying 
drawing below. Drawing 1 shows the plane view of the transit way of an 
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uninhabited car. The sectional view according [ drawing 2 ] to view line BB-BB 
and drawing 3 are the side elevations by the view line CC. A works building etc., 
avoiding KJ From a starting point A, in the direction of true north in the 
straight-line way L1, the radii way C1 in which it circles 90 degrees clockwise 
from a B point to C point, and the direction of an east from the straight-line way 
L2 and D point to E points In the radii way C2 and the direction of true north in 
which it circles 90 degrees counterclockwise, from the straight-line way L3 and F 
points to G points In the radii way C3 and the direction of a northwest in which it 
circles 45 degrees counterclockwise, from the straight-line way L4 and H points 
to I points It is the transit way which runs straight-line way L6 in the radii way C4 
in which it circles 45 degrees clockwise, and the direction of true north, and 
reaches a terminal point L at them in the straight-line way L5, the radii way C5 in 
which it circles 90 degrees clockwise from J point to K points, and the direction of 
an east. 

[0008] The landmark LM shown by the round mark is laid under the transit way in 
the predetermined location, and the pitch tilt angle theta and roll inclination angle 
phi to a horizontal plane HL are small formed with three or less abbreviation on 
each radii way, respectively. In the transit control device of Car V, the storage 
which made each tilt angles theta and phi of each above-mentioned radii way 
remember it beforehand to be plane view locus data of this transit way is 
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provided. Moreover, 1 shaft gyroscope JR which is a yaw angle sensor is carried 
in Car V. 

[0009] The transit direction of a car is corrected as compared with said plane 
view locus data, this 1 shaft gyroscope JR detecting the travelling direction 
(azimuth) of this car V, and it is made to run in the direction of the right. Moreover, 
detection errors, such as a drift error of 1 shaft gyroscope, are reset with the 
landmark LM in each location, and transit control of between each landmark is 
carried out with 1 shaft gyroscope. 

[0010] However, when a car runs, even if the output of 1 shaft gyroscope sensor 
which can detect a yaw angle detects a yaw angle, when an inclination exists in 
the curve of a transit way, the output value of 1 shaft gyroscope does not show 
an exact azimuth under the effect of the pitch tilt angle theta of the curve, and roll 
inclination angle phi. Then, using time amount rate-of-change psi' of Azimuth psi 
being expressed by the following strict formula (1), the exact azimuth psi is 
acquired and the technique of meeting [ technique ] a transit way surely and 
running it Car V is explained. 
[0011] 

psi'=-sin theta-omega x-sin phi-cos theta-omega y +cosphi-costheta-omegaz .... 
(1) 

omega x: Angular velocity of the circumference of the travelling direction x axis 
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of a car (rolling angular velocity) 

omegay: Angular velocity of the circumference of the y-axis of the direction 
which intersects perpendicularly with a x axis (pitching angular velocity) 
omegaz: Revolution angular velocity of a car [0012] Since both the pitch tilt 
angle theta of each radii way and roll inclination angle phi are small, on the usual 
transit way, angular velocity omega x and omegay can be set with 0, and a 
formula (1) turns into a degree type. 

psi-cosphi-costheta-omegaz - it is as follows when the 
double-size-of-character formula of a trigonometric function is applied here. 
psi'= (1-2, sin2 (phi/2)) -(1-2, sin2 (theta/2))- Both, since it is small, omegaz pitch 
tilt angle theta and roll inclination angle phi become as the following. 
psi'=(1-phi2/2) -(1-theta2/2) - omegaz =omegaz- 0.5-(phi2+theta2) - 
omegaz+0.25, phi2, theta2, and omegaz ~ since the 3rd term is a high order 
minute term, if it is disregarded, it will become a degree type here. 
psi-omegaz-0.5 -(phi2+theta2)- omegaz [0013] If the revolution elapsed time t is 
integrated with this formula, Azimuth psi will be expressed by the following 
formula. For convenience, [is used as an integral notation, 
psi =[omegazdt-0.5, [(phi2+theta2), and omegazdt .... (2) 
= [omega zdt-deltapsi .... (3) 
deltapsi=0.5, [(phi2+theta2), and omegazdt .... (4) 



Since 1 shaft gyroscope which is a yaw angle sensor outputs [omegazdt as a 
yaw angle, the semantics of a formula (3) is that Azimuth psi can be found 
correctly, when amendment which deducts correction value deltapsi from this 
output-value [omegazdt is performed. If phi and theta are fixed in a curve, 
correction value deltapsi will become a degree type. 

deltapsi=0.5 -(phi2+theta2)- [omegazdt [0014] The pitch tilt angle theta of the 
radii way C1, roll inclination angle phi, revolution angular-velocity [ of a car ] 
omega z, and the include angle psi in which the car measured in a horizontal 
plane should circle, i.e., an azimuth, are the value phi like a less or equal, 
respectively. : 1.15 degree theta : 2.86 degree psi : It is 90 degrees, and since it 
is easy, when omegaz is 5.31 degrees/second of constant value, correction 
value deltapsi is computed per. First, [omegazdt=90.13 degree is obtained by 
the formula (2). Next, deltapsi=0.13 degree is obtained by a formula (3) or the 
formula (4). 

[0015] That is, although he wants for Car V to circle 90 degrees in a horizontal 
plane in the direction of the circumference of a clock from a location B, and to 
arrive at a location C, and bearing of a car is appointed with the detection include 
angle of 1 shaft gyroscope JR in directional control in the meantime, when 
Azimuth psi becomes 90 degrees, output [omegazdt of 1 shaft gyroscope is 
90.13 degrees. Therefore, before Azimuth psi will become 90 degrees if it says 
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conversely, and there is no amendment means, a car is judged to be what 
circled 90 degrees with 1 shaft gyroscope. It cannot arrive at the location C of a 
revolution termination target, but straight-line transit control of the straight-line 
way L2 which is the following transit path is started in this side location C\ and it 
is made to run in the direction of a broken line of a direction [omegazdt= 90 
degrees now. Therefore, it may result in location LIVT biased on the north side 
which cannot detect this landmark LM depending on the distance to the following 
landmark LM. 

[0016] If it amends so that the value (90 degrees) which subtracted correction 
value deltapsi=0.13 degree from the output-value [omegazdt=90.13 degree of a 
gyroscope may be made into an output value in order to prevent this, Point C will 
be reached correctly. Although considered as amendment in the condition of 
having carried out revolution termination of the radii way C1, in this explanation, 
whenever 1 shaft gyroscope detects a yaw angle every moment, subtraction 
amendment of the output-value [omegazdt at that time can be carried out by 
correction value deltapsi (formula (4)) corresponding to it for every detection of 
multiple times, and Azimuth psi can be searched for (formula (3)). 
[0017] In this way, if Azimuth psi is correctly detectable, it can run in the direction 
of an east along the straight-line way L2. Also on the radii way C2, a gyroscope 
output is again amended like the above, and it can run in the direction of true 



north of the straight-line way L3. Although a revolution include angle is 45 
degrees on the radii way C3, the amendment approach being the same, being 
able to run along the straight-line way L4 after amendment, and amending it 
similarly after that, it can go via it with the radii way C4, the straight-line way L5, 
the radii way C5, and straight-line way L6, and it can reach the last destination L. 
[0018] The flow Fig. showing the above transit control in drawing 5 explains. In 
step 30, from the starting point A, transit is started and the existence of 
Landmark LM is judged in step 32. If there is a landmark, it will progress to step 
34 and the landmark will judge whether it is the landmark (B point) of initiation of 
a curve C1 . If it is the landmark of curve initiation, while resetting detection errors, 
such as a drift error of a gyroscope, at step 36, theta and phi are read into a 
store whenever [ tilt-angle / of the curve made to memorize beforehand ]. 
[0019] Next, in step 38, revolution transit of the curve C1 is carried out, the 
output value of Gyroscope JR is read in step 40, and it amends according to a 
formula (4). In step 32, the existence of a landmark is judged again, if there is a 
landmark, in step 34, it will judge whether it is the landmark of initiation of a curve, 
but since the last landmark was made into the initiation landmark, it is the 
landmark which shows revolution termination, and since this landmark is not an 
initiation landmark, it progresses to step 42, it is judged in here to be the 
termination landmark of a curve, and progresses to step 44. Detection errors, 



such as a drift error of a gyroscope, are made to reset in step 44, and 
straight-line transit control is started in step 46. 

[0020] If a landmark is not a landmark which shows termination of a curve in said 
step 42, it will progress to step 52 and this landmark will judge whether it is the 
landmark of a terminal point L. If it is not a terminal point, it is a landmark in the 
middle of straight-line transit, and it progresses to step 44, and detection errors, 
such as a drift error of a gyroscope, are made to reset. Moreover, if judged with a 
terminal landmark in step 52, it will be made to stop in step 54. 
[0021] If judged with there being no landmark in step 32, when it shifts to step 48, 
and it is judged [ predetermined ] from the landmark of 1 time ago whether 
distance transit was carried out, consequently predetermined distance transit 
has not yet been carried out, it will progress to step 46, and straight-line transit 
will be continued as it is. If it judges with having already run a predetermined 
distance in step 48, since a landmark still is not detected, as the broken line (C 
and LM' between) showed to drawing 2 , the direction of transit will have shifted, 
and an emergency shut down will be spontaneously carried out to step 50 in this 
case. 

[0022] In the above FURO description of drawing, although the curve was 

explained per C1 , other curves are the same. 

[0023] 



[Effect of the Invention] Also when the path it should run according to this 
invention has become settled so that clearly from the above explanation, and 
this transit way has an inclination to a horizontal plane, the detection precision of 
the azimuth by the yaw angle sensor currently used for the transit control unit of 
an uninhabited car can be held by low cost. 



DESCRIPTION OF DRAWINGS 
[Brief Description of the Drawings] 

[Drawing 1] Drawing 1 is drawing showing the principle of the transit control unit 
of the uninhabited car concerning this invention. 

[Drawing 2] Drawing 2 is the top view showing the example of the transit path of 
the uninhabited car concerning this invention. 

[Drawing 3] Drawing 3 is a sectional view by view line BB-BB of drawing 2 . 
[Drawing 4] Drawing 4 is a side elevation by the view line CC of drawing 2 . 
[Drawing 5] Drawing 5 is the flow Fig. showing transit control. 
[Description of Notations] 
C1, C5 Radii way (curve) 
V Uninhabited car 



theta Pitch tilt angle of a curve 
phi Roll inclination angle of a curve 
psi Azimuth 

omegaz Revolution angular velocity of a car 
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